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基于 ROS 的 ICP-SLAM 在 内 入 式 移动 机 器 人 上 的 实现 与 优化 
郑 富 瑜 ， 何 ” 苗 '， 张 ” 辉 ， 赵 韦 人 ， 熊 德 平 ， 梁 安 辉 ， 王 成 民 ， 王 ” 渔 ， 周 海 亮 


(广东 工业 大 学 物理 与 光电 工程 学 院 ,广州 510006) 


摘 要 : 基于 激光 雷达 的 ICP-SLAM 在 机 器 人 操作 系统 中 无 法 直接 运行 ， 且 通过 PC 实现 算法 时 ， 没 有 高 效 运载 计算 
机 资源 ， 产 生 资源 浪费 ， 同 时 降低 了 移动 机 器 人 系统 的 灵活 性 。 通 过 在 内 入 式 系统 中 搭建 机 器 人 操作 系统 ， 在 系统 中 
移植 MRPT 函数 库 中 的 ICP-SLAM 算法 ， 对 算法 进行 优化 ， 调 整 算法 运行 的 CPU 占用 率 ， 使 用 基于 激光 雷达 的 移动 
机 器 人 进行 建 图 。 结 果 表明 机 器 人 操作 系统 生成 的 栅 格 地 图 可 以 满足 机 器 人 自主 导航 的 需求 ，SLAM 效果 更 为 直观 ， 
系统 更 加 灵活 ， 成 本 和 硬件 配置 要 求 大 大 降低 。 证 明 优化 后 的 算法 更 贴近 实际 的 使 用 需求 。 
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Implementation and optimization of ROS based ICP-SLAM embedded robot 


Zheng Fuyu, He Miao', Zhang Hui, Zhao Weiren, Xiong Deping, Liang Anhui, 
Wang Chengmin, Wang Run, Zhou Hailiang 
(School of Physics & Optoelectronic Engineering Guangdong University of Technology, Guangzhou 510006, China) 


Abstract: Laser-based ICP-SLAM cannot run directly in the robot operating system, and there is no efficient carrying of 
computer resources when implementing the algorithm on PC, resulting in waste of resources, while reducing the flexibility of 
mobile robot system. Build robot operating system on the embedded system, transplant the ICP-SLAM algorithm of the MRPT 
library into the system, optimize and fixthe CPU occupancy rate of the algorithm, test the function of SLAM by the mobile robot 
based on the LIDAR. The results show that the grid map thatrobot operating system generated have met the requirements of 
robot autonomous navigation, and theeffect of SLAM is more intuitive, besides, the system is more flexible, greatly reducecost 
and hardware configuration requirements. Proved that the optimized algorithm is closer to the practical requirements. 
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ICP 算法 在 可 能 会 收敛 到 局 部 最 优点 上 ， 提 高 了 算法 对 于 传 感 


器 的 要 求 由 。ICP-SLAM 算法 将 新 的 测 距 扫 描 结果 与 上 


次 结 


即时 定位 与 构建 地 图 (SLAM) 技术 是 移动 机 器 人 实现 自 果 生 成 的 点 云图 进行 匹配 , 从 而 增 量 地 构建 地 图 日 。 点 云图 随 着 


主导 航 的 关键 ， 在 未 知 环境 中 ， 通 过 传感器 对 周围 进行 探测 ， 时 间 的 推移 计算 量 持续 增 大 ,增加 了 系统 的 负担 四 。ICP-SLAM 
构建 出 环境 地 图 ， 对 机 器 人 进行 定位 ， 从 而 结合 传感器 生成 的 。 需要 比特 征 提取 更 多 的 计算 量 ， 在 PC Linux 系统 中 使 用 ICP- 
实时 地 图 进行 导航 。 在 SLAM 的 研究 过 程 中 , 使 用 视觉 传感器 。 SLAM， 结 合 高 分 辨 率 的 激光 雷达 可 以 较 好 的 实现 高 精度 的 
的 方式 容易 受到 环境 光 的 干扰 ， 生 成 的 数据 量 巨大 ， 限 制 了 传 SLAM 效果 , 但 使 用 PC 相当 于 提高 硬件 配置 , 且 只 占用 PC 很 


感 器 的 应 用 环境 , 同时 提高 了 数据 处 理 的 成 本 中 ,移动 机 器 人 进 ”小 一 部 分 的 功能 , 造成 功能 浪费 和 成 本 增加 中 ,但 移动 机 器 人 的 
行 SLAM 时 ， 通 过 传感器 收集 到 的 数据 还 原 环 境 分 布 ， 使 用 自 普通 人 谍 入 式 开发 板 配置 不 够 ， 无 法 实现 高 精度 的 地 图 构建 和 机 


法 求解 机 器 人 的 位 姿 加 。ICP 算法 由 Besl 和 McKay 于 1992 恒 


ih 


出 ， 是 一 个 快速 旦 精确 的 算法 ， 在 图 像 和 点 集 的 配 准 中 得 到 ” ” 点， 无 法 使 用 ROS 评估 工具 进行 仿真 平台 的 验证 。 


n 


的 应 用 握 。 由 于 初 值 不 佳 或 者 在 扫描 匹配 过 程 中 出 现 误差 ， 针对 以 上 ICP-SLAM 无 法 在 ROS 中 运行 ， 硬 件 配 
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器 人 实时 定位 。MRPT 库 中 的 ICP-SLAM 没有 在 ROS 中 的 节 
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对 于 移动 机 器 人 普通 能 入 式 不 适用 的 问题 ， 本 文 将 MRPT C++ ”使 用 栅 格 图 进行 扫描 匹配 激光 雷达 得 到 的 环境 
库 中 的 ICP-SLAM 移植 在 移动 机 器 人 先入 式 开发 板 上 ， 保 留 算 mrpt icp_slam 2d_ wrappercpp 加 入 读 取 里 程 计 的 读数 odom 的 
法 的 部 分 源码 并 作出 修改 ， 优 化 地 图 构建 中 的 耗 时 与 计算 资源 函数， 再 对 里 程 计 的 读数 进行 四 元 数 的 转换 ， 为 扫描 匹配 初期 
的 部 分 ， 增 加 基于 栅 格 地 图 实时 轨迹 显示 部 分 等 。 移 植 后 的 ICP 算法 提供 初 值 姿 态 和 矩阵 ，ICP 算法 加 入 机 器 人 里 程 计 提 供 
ICP-SLAM 大 大 降低 了 对 硬件 平台 的 要 求 ， 提 高 了 系统 的 灵活 “初始 姿态 矩阵 ， 大 大 减少 初始 时 刻 全 局 搜索 带 来 的 时 间 消 耗 。 
性 ， 显 示 效 果 更 为 直观 ， 还 添加 了 实时 轨迹 的 显示 ， 提 升 了 在 mrpt icp slam 2d wrapper.cpp 中 删 去 3D 显示 窗口 
SLAM 的 性 能 ， 精 确 反 映 了 周围 环境 的 布局 。 3DWindows， 关 闭 同 时 定位 与 地 图 构建 的 实时 显示 ， 同 时 添加 
1 ”算法 优化 与 改进 轨迹 显示 updatetrajectory， 采 用 基于 ROS 的 图 形 工具 RVIZ 进 
行 界 面 和 轨迹 的 显示 。 
1.1 总 体 流程 设 1.3 ”扫描 匹配 
ea 进行 扫描 匹配 时 , 最 邻近 点 迭代 (iterative closest point, ICP ) 
器 人 内 入 式 ROS 平台 中 的 移植 和 优化 , 最 终 在 显示 终端 显示 基 。 ”算法 通过 最 小 化 匹配 误差 求解 旋转 矩阵 与 平移 矩阵 ， 在 MRPT 
于 ROS 平台 的 包含 运动 轨迹 的 栅 格 地 图 ， 即 地 图 的 实时 构建 。 ”C++ 库 中 有 多 种 不 同 的 方法 。 算 法 对 扫描 得 到 的 数据 帧 进行 匹 
算法 可 以 分 成 以 下 几 个 步骤 : 完成 选择 控制 点 ， 扫 描 匹 配 , 通 。 配 、 更 新 局 部 区 域 地 图 、 调 整 局 部 地 图 偏差 ， 由 于 缺少 初始 姿 
过 最 小 化 匹配 点 误差 方程 求 出 旋转 矩阵 与 平移 矩阵 ， 即 时 定位 “， 态 矩 阵 ， 达 到 收敛 条 件 需要 的 迭代 次 数 大 量 增 加 。 考 虑 到 耗 时 
和 地 图 构建 。 总 体 的 系统 设计 流程 如 图 1 所 示 。 选 择 控制 点 在 上 且 使 用 里 程 计 提 供 初 始 姿态 矩阵 对 于 扫描 匹配 的 精度 影响 较 小 ， 
激光 雷达 与 里 程 计 部 分 完成 ， 扫 描 匹 配 之 后 ， 进 行 迭 代 求 出 旋 ”同时 和 迭代 次 数 减少 降低 了 对 嵌入 式 开发 板 CPU 计算 量 的 载荷 ， 
转 、 平 移 和 矩阵， 不 断 迭 代 ， 求 解 机 器 人 的 运动 ， 完 成 即时 定位 ”为 嵌入 式 的 引入 提供 契机 。 
和 地 图 构建 。 ICP 算法 在 MRPT C++ 库 中 有 多 种 方法 ， 主 要 包括 经 典 点 
云 匹 配方 法 ， 经 典 ICP 方法 〈Classic ICP) 四 ， 列 文 伯 格 - 马 夸 
尔 特 方法 (Levenberg-Marquardt, LM) 外 、 八 又 树 图 方法 (octomap) 
n0 和 栅 格 地 图 方法 〈gridmatch ) 等 山 。 本 文 将 扫描 匹配 算法 中 
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点 云 匹 配 的 方式 调整 为 栅 格 地 图 匹配 ， 和 避免 了 后 期 点 云 匹 配 长 
SM 时 间 匹 配 产生 的 大 量 迭 代 计算 ， 确 保 精确 率 的 基础 上 降低 对 硬 
| 后 的 要 求 ， 更 加 适用 于 插入 式 开发 板 的 配置 。 优 化 后 的 扫描 匹 
配 流程 如 图 2 所 示 。 激 光 雷 达 采 集 到 数据 之 后 ， 通 过 对 编码 器 
openration —— A 为 主要 结构 的 里 程 计 读 数 进行 检测 ， 机 器 人 位 移 小 于 一 定 阔 值 
| 时 ， 不 进行 旋转 平移 匹配 ， 沿 用 上 一 帧 栅 格 图 。 
Complete? LASER 一 
Y | -Cridmapl 
Odometry 一 
Save Map Rotate 
Translate 
Matrix | 
图 1 总 体 设 计 流 程 LASER 
在 上 述 系统 设计 流程 中 ， 本 文通 过 修改 ICP-SLAM 算法 源 Nn 
代码 部 分 的 C++ 代码 ， 同 时 删 去 了 与 本 文 ICP-SLAM 方法 不 同 4 Scan/Mateh 


的 源 代 码 ， 包 括 MRPT C++ 库 中 的 EKF、RBPF 和 Graph-slam 
方法 ; 在 地 图 的 匹配 方式 与 方法 上 进行 改进 ， 优 化 算法 对 于 
CPU 需求 的 计算 量 ; 在 ROS 的 图 形 显示 工具 中 进行 SLAM， 1.4 ROS 显示 与 观测 


图 2 扫描 匹配 流程 


添加 路 径 的 显示 。 机 器 人 操作 系统 (ROS) 是 一 个 机 器 人 软件 操作 平台 ， 前 身 
1.2 1ICP-SLAM 源 代 码 斯 坦 福 大 学 人 工 智 能 研究 所 (Stanford Artificial Intelligence 
ICP-SLAM 算法 的 主要 在 src 和 include 文件 夹 下 实现 ， 在 Laboratory) 所 研发 。ROS 可 以 建立 节点 管理 器 ， 从 命令 行 客户 


mrpt_icp_slam 2d_wrapper.cpp 中 使 用 栅 格 地 图 数据 occu_msg 端 查看 特定 主题 不 断 发 布 的 消息 数据 (2。 
蔡 换 点 云 地 图 数据 ; 对 匹配 点 搜索 使 用 的 方法 进行 修改 , 将 icp- 为 了 能 够 借助 ROS 的 评估 工具 和 功能 , 在 租 入 式 开发 板 上 
slam-live.ini 文件 中 的 匹配 方法 ICP_algorithm 改 为 grid map， 安装 Ubuntu 并 搭载 ROS 平台 ， 订 阅 激光 雷达 采集 数据 后 发 布 
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的 Laserscan 主题 ,在 ROS 中 创建 节点 ,移植 ICP-SLAM 算法 ， 


将 源 代码 放置 于 src 文件 夹 下 , 将 ini 可 执行 文件 放置 于 tutorial 


文件 夹 中 ， 创 


建 launch 文件 同时 驱动 多 个 节点 ,包括 订阅 激光 
雷达 发 布 的 主题 的 节点 、 使 用 ICP-SLAM 可 执行 文件 进行 建 


册 本 


Chi 
: 基于 ROS 的 ICP-SLAM gk KD 
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郑 富 瑜 ， 等 人 上 的 实现 与 优化 
进行 算法 的 测试 时 ， 个 人 电脑 计算 能 力 强 ， 存 储 空间 大 ， 


但 运行 ICP-SLAM 时 只 用 到 小 部 分 运算 能 力 ， 对 于 移动 机 器 
开发 而 言 ， 个 人 电脑 与 机 器 人 的 捆绑 开发 不 仅 导致 未 使 用 的 
算 资 源 严重 浪费 ， 且 提升 了 硬件 配置 成 本 和 功 耗 ， 降 低 了 系 


的 节点 和 使 用 ROS 图 像 显 示 界 面 工具 RVIZ 进行 实时 
过 程 。 同 时 ， 
ROS 中 主题 的 发 布 与 订阅 如 图 3 所 示 。 通 过 
程 计 发 布 的 主题 odom 和 激光 雷 


算法 会 对 采集 到 的 数据 进行 处 理 。 


turtlebot3_core 
mrpt_icp_slam live 2d 


rw 


图 3 ROS 主题 发 布 与 订阅 


如 urtlebot3_core 
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2 算法 的 测试 与 结果 解析 
测试 硬件 配置 

测试 的 硬件 配置 为 台 
器 人 底盘 ， 将 使 用 台式 计算 机 运行 算法 与 机 器 人 采 


2.1 


显示 建 
在 RVIZ 的 实时 显示 中 添加 机 器 人 的 运动 轨迹 。 
订阅 移动 机 器 人 里 
达 发 布 的 主题 scan, ICP-SLAM 


小 和 适当 的 CPU 运算 效率 等 优点 ， 成 为 SLAM 算法 运行 时 


i 式 计算 机 、 激 光 雷 达 和 自制 的 移动 机 
嵌入 式 开 


发 板 独立 运行 算法 的 对 比 。 机 器 人 采用 的 激光 雷达 采 ) 


] 二 维 激 


光 雷 达 ， 移 动机 器 人 底盘 模块 主要 由 上 位 机 和 下 位 机 组 


成 ， 上 


位 机 主要 由 移动 机 器 人 普通 租 入 式 开发 板 树 董 派 三 
成 ， 树 莓 派 负 责 激光 雷达 获取 数据 的 处 理 、ROS 软件 上 
SLAM ee 令 的 发 布 ，PC 用 于 
发 板 处 理 之 后 的 数据 和 图 形 界 了 
仅 发 挥 观测 的 作用 
有 机 了 驱动 板 、 集 成 磁 电 编 
Arduino Uno 的 开发 板 主 要 负责 机 
磁 电 编码 器 的 


码 器 的 直流 电机 和 电源 组 成 ， 
器 人 的 移动 功能 实现 ， 


显示 开 
。 下 位 机 主要 由 基于 Arduino Uno 的 开发 板 、 


代 和 PC 组 


ICP- 


直流 电机 负责 产生 里 程 计 数据 ,机 器 人 的 上 、 


机 供电 统 
别 是 机 器 人 整体 图 、 


电源 提供 。 
树 侮 派 开发 板 与 激光 雷达 。 


图 4 硬件 配置 实物 图 
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测试 硬件 配置 实物 图 如 图 4 所 示 ， 分 


人 电脑 的 替代 品 。 表 1 所 示 为 个 人 电脑 与 嵌入 式 开发 板 树 侮 
三 代 的 硬件 参数 对 比 。 除 此 之 外 ， 硬 件 的 价格 上 ， 树 莓 派 只 
要 40 美元 左右 ， 价 格 约 为 PC 的 10%。 


人 
计 
统 


的 灵活 性 与 集成 性 。 艇 入 式 开发 板 以 其 低 成 本 、 低 功 耗 、 体 积 


小 
派 


Eg 
mT 


表 1 硬件 参数 对 比 
PC Raspberry Pi 
Intel(R) core(TM) i5-4660 Quad Core 1.2GHz Broadcom 
on CPU@3.20GHz BCM2837 64bit CPU 
Storage 777GB Micro SD card 32GB 
Memory 4G DDR3 1600MHz 1GB 


2.2 不 同 匹 配 算法 仿真 对 比 
使 用 不 同 的 ICP 匹配 算法 进行 扫描 匹配 时 ， 精 确 程 度 不 
相同 ， 除 了 实时 建 图 质量 可 以 反映 精度 之 外 ， 还 可 上 L 


SLAM 定位 功能 生成 的 轨迹 来 判断 。 不 同 算法 产生 的 轨迹 与 


实 值 之 间 的 误差 不 同 , 为 了 得 到 轨迹 的 真实 值 , 使 用 


在 模拟 的 环境 中 进行 运动 ， 得 到 运行 轨迹 的 真实 值 文件 和 数 
包 ， 通 过 选择 不 同 ICP 匹配 算法 运行 同一 数据 包 ， 得 到 对 应 
轨迹 文件 ， 使 用 MATLAB 仿真 对 比 轨 迹 
库 中 几 种 不 同 的 匹配 算法 产生 的 轨迹 ， 
列 文 信 


包括 气体 映射 方 


(gas mapping)、 


MRPT C++ 
库 apps 文件 夹 下 的 模拟 器 ， 通 过 运行 模拟 器 中 的 模型 机 器 人 ， 


据 
的 


实 值 与 MRPT C++ 


法 


格 - 马 夸 尔 特 方法 (Levenberg-Marquardt， 


LM)、 八 又 树 图 方法 (octomap) 和 栅 格 地 图 方法 (gridmatch) 
与 真实 值 (Ground Truth) 的 轨迹 ， 得 到 的 轨迹 图 如 图 5 所 示 。 


不 同 匹配 方法 与 真实 值 的 方差 如 表 2 所 示 。 


Robot Trajectory With Different Matching Algorithm 


一 一 GT-eround truth 
] | 一 一 cndmap 0.0042 
一 一 Mooo21 

| | 一 -cassicoo155 


一 一 octo 0.049 


Y-Asix 


对 
对 


5 不 同 匹配 方法 轨迹 


表 2 不 同 匹 配方 法 与 真实 值 的 方差 
Matching Algorithm Gridmap LM Classic Octomap 
Variance 0.0042 0.0021 0.0155 0.049 
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根据 表 2， 使 用 列 文 伯 格 - 马 夸 尔 特 方法 (LM) 与 真实 值 的 
方差 最 小 , 为 0.002 1， 小 于 使 用 栅 格 地 图 方法 的 方差 0.004 2， 


但 在 嵌入 式 开发 板 运行 过 程 中 , 使 用 LM 方法 的 


CPU 的 占用 率 


远大 于 使 用 栅 格 地 图 , 当 CPU 占用 率 过 高 时 , 算法 的 运行 速度 
和 数据 处 理 速度 会 受到 限制 ， 即 时 建 图 容易 产生 漂移 ， 导 致 地 
图 的 精度 下 降 甚至 无 法 建立 完整 的 地 图 。 表 3 所 示 为 算法 运行 
时 嵌入 式 开发 板 运行 的 CPU 占用 率 。 由 于 骨 入 式 开 发 板 的 CPU 
计算 资源 十 分 宝贵 ， 列 文 伯 格 - 马 夸 尔 特 方法 明显 对 CPU 的 消 


耗 更 大 ， 当 嵌入 式 开发 板 在 移动 机 器 人 上 使 用 时 ， 复 条 的 环境 
会 导致 CPU 的 浮动 更 加 明显 ， 更 低 的 CPU 消耗 让 开发 板 的 容 


错 率 更 高 ， 鲁 棒 性 更 好 。 


表 3 不 同 匹 配方 法 嵌入 式 开发 板 的 CPU 占用 率 


Algorithm Max Average Min 
Gridmap 40.35% 38.76% 36.84% 
LM 56.82% 49.84% 48.34% 
Classic 50.77% 47.68% 45.31% 
Octomap 66.58% 63.49% 62.44% 


2.3 优化 后 的 算法 测试 


测试 场地 为 7.8m x15m 大 小 的 办 公 区 域 , 使 用 基于 二 维 激 


光 雷 达 的 移动 机 器 人 底盘 进行 即时 定位 和 建 图 。 


器 人 底盘 SLAM 生成 的 地 图 ， 黑 色 部 分 是 障碍 物 ， 白色 为 可 通 
行 区 域 ， 绿 色 实 线 为 机 器 人 底盘 的 运动 轨迹 。 对 比 图 7 使 用 抱 
入 式 开发 板 运行 MRPT C++ 库 中 的 ICP-SLAM 生成 的 地 图 与 图 
8 使 用 PC 作为 运算 单元 运行 MRPT C++ 库 ICP-SLAM 生成 的 


图 6 所 示 为 机 


地 图 , 图 6 使 用 先入 式 开发 板 运行 改进 后 的 ICP-SLAM 算法 的 


方式 生成 的 地 图 可 以 明确 辨认 出 障碍 物 的 位 置 、 


机 器 人 运动 的 轨迹 ， 验 证 了 使 用 嵌入 式 开发 板 的 可 行 性 与 实用 


环境 的 布局 、 


性 。 图 7 由 于 和 骨 入 式 开发 板 在 运行 时 内 存 耗 尽 ， 


漂移 ， 导 致 即 时 建 图 的 准确 率 降 低 ， 而 图 8 由 于 PC 硬件 配置 


较 高 ， 建 图 时 清晰 度 与 对 比 度 较 高 ， 并 在 运行 


容易 产生 地 图 


添加 机 器 人 模 


型 ， 但 该 图 生成 时 ， 算 法 选择 点 云 与 栅 格 图 同时 生成 ， 让 边缘 


部 分 厚度 增加 ， 且 没有 路 径 显示 ， 不 能 够 直观 反映 机 器 人 的 实 


时 定位 。 


图 6 ICP-SLAM 构建 地 图 
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图 7 MRPT C++ 库 ICP-SLAM 


图 8 PC 运行 ICP-SLAM 


2.4 总 体 改 进 效 果 

将 移植 后 的 ICP-SLAM 在 嵌入 式 开发 板 上 运行 与 在 系统 中 
运行 MRPT C++ 库 中 的 ICP-SLAM 进行 对 比 ， 同 一 个 数据 包 ， 
在 虑 入 式 开 发 板 系统 中 使 用 MRPT C++ 库 中 原始 的 ICP-SLAM 
运行 时 ， 和 迭代 的 总 次 数 为 27 349 次 ， 运 行 时 间 为 15 min 37 s， 
使 用 优化 后 ICP-SLAM 算法 迭代 次 数 为 2 954 次 ， 运 行 时 间 为 
5 min 29 s，CPU 占用 率 上 ， 使 用 MRPTC++ 库 中 原始 的 ICP- 
SLAM 平均 值 达到 136%， 优 化 后 降低 到 了 38.76%。 移 植 后 的 
算法 提高 了 运算 速率 , 同时 降低 了 CPU 占用 率 , 确保 了 运行 时 
算法 的 测量 准确 率 不 会 因 CPU 资源 耗 尽 而 产生 下 滑 。 

将 生成 的 地 图 通过 ROS 节点 map_server 保存 下 来 ， 移 动 
机 器 人 使 用 自 适 应 蒙特 卡 洛 定位 (adaptive Monte Carlo 
localization, AMCL) 算法 ,结合 激光 雷达 进行 室内 的 导航 ， 导 
航 效果 如 图 9 所 示 。 


图 9 保存 地 图 进行 导航 
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移动 机 器 人 嵌入 式 开发 板 树 莓 派 三 代 中 ， 
同时 算法 的 运行 速度 和 CPU 占用 率 两 方 
了 移动 机 器 人 实现 SLAM 硬件 配置 要 求 和 设备 的 成 本 。 针 对 扰 
入 式 开 发 板 运算 速率 有 限 导致 MRPT C++ 库 中 ICP-SLAM 不 适 
的 问题 ， 
式 为 栅 格 图 匹配 ， 去 除 ICP-SLAM 实时 显示 界面 


结束 语 


本 文 提 出 并 实现 了 将 ICP-SLAM 进行 改进 和 优化 , 移植 到 
最 终 实现 了 SLAM; 
下 得 到 提升 , 大 大 降低 


在 保证 精确 率 的 基础 上 ， 通 过 修改 原点 云图 匹配 方 
， 降 低 了 算法 


对 CPU 计算 量 的 需求 , 缩短 了 算法 运行 耗 时 。 关 于 构建 地 图 过 


程 中 显示 不 够 直观 的 问题 , 采用 在 ROS 平台 


T 


使 用 RVIZ 图 像 


显示 界 


加 了 路 径 显 示 功 能 ， 既 符合 现在 的 机 器 人 研究 趋势 ， 又 更 加 直 


面 ， 结 合 自 带 评估 


在 PC 终端 中 进行 显示 ; 同时 添 


观 地 反映 了 实际 环境 的 布局 。 通 过 对 算法 的 改进 ， 从 而 提高 了 
移动 机 器 人 的 集成 度 和 灵活 度 , 降低 了 移动 机 器 人 的 硬件 成 本 。 
随 着 先入 式 技 术 的 不 断 发 展 ,嵌入 式 机 器 人 的 功能 将 不 断 延 伸 
普及 生活 中 的 更 多 领域 。 
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